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REPLACEMENT 



FIG.IO 



INmALIZATIOM(t=0,ETC.) 



WAIT FOR TIMER INTERRUPT (FOR EACH CONTROL CYCLE). 



IS GAIT 
CHANGING? 



t = 0 



1 S018 



READ NEXT TIME GAIT SUPPORTING LEG COORDINATE SYSTEM, 
NEXT BUT ONE TIME GAIT SUPPORTING LEG COORDINATE SYSTEM, 
CURRENT TIME GAIT aCLE, AND NEXT TIME GAIT CYCLE. 



SUBROUTINE FOR DETERMINING GAIT 
PARAMETER OF NORMAL GAIT 
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SUBROUTINE FOR DETERMINING INITIAL STATE 
(INITIAL DIVERGENCE COMPONENT, ETC.)OF NORMAL GAIT 



PROVISIONALLY DETERMINE GAIT PARAMETER OF CURRENT HME GAIT 
INCLUDING DESIRED FLOOR REAO10N FORCE VERnCAL COMPONENT 



SUBROUTINE FOR CORRECnNG CURRENT TIME GAIT PARAMETER 
(CORREQ CURRENT TIME GAIT PARAMETER SUCH THAT DIVERGENCE 
COMPONENT AT END OF CURRENT TIME GAIT AGREES WITH INITIAL 
DIVERGENCE COMPONENT OF NORMAL TURNING GAIT.) 



DETERMINE PARAMETERS OF ZMP PERMISSIBLE RANGE AMD FLOOR 
REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE 
FOR FULL-MODEL CORREQION. 



SUBROUTINE FOR DETERMINING CURRENT TIME GAIT INSTANTANEOUS VALUE 



S032 



DETERMINE ARM SWINGING OPERATION TO CANCEL SPIN FORCE 



DETERMINE INSTANTANEOUS VALUES OF ZMP PERMISSIBLE RANGE AND FLOOR REAaiON 
FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE FOR FULL-MODEL CORRECHON. 



GENERATE CORRECTED GAIT USING FPU MODEL | ^ 
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FIG.12 



DETERMINE INITIAL STATES (STATES AT INIllAL TIME Ts) OF FOOT POSITION/POSTURE, BODY 
POSTURE ANGLE 8 bs, AND ARM POSTURES ON THE BASIS OF NORMAL TURNING GAIT PARAMETER. 



PROVISIONALLY DETERMINE INITIAL (AT Ts) BODY HORIZONTAL POSITION, VELOCITY, 

ANGUUR VELOQTY, AND BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE PEAK VALUE 

CANDIDATES (Xs, Vxs, cubs, ZMPrecpeok). 



DETERMINE INITIAL BODY VERTICAL POSITIONAELOCITY (Zs/Vzs). 



USING DYNAMIC MODEL, GENERATE GAIT FOR ONE STEP ON THE BASIS OF NORMAL 
TURNING GAIT PARAMETER INCLUDING ZMPrecpeok, TAKING e bs,(Xs, Vxs, cobs), 
(Z5,Vz5) AS INITIAL STATES OF BODY. 
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CONVERT TERMINAL BODY HORIZONTAL POSITION, VELOOTY, POSTURE ANGLE, AND ANGUUR 
VELOGTY OF GENERATED GAIT INTO VALUES OBSERVED FROM SUPPORTING LEG COORDINATE SYSTEM 
OF NEXT STEP, AND DENOTE THE VALUES BY (Xe, Vxe, 8 be, cobe). 



BOUNDARY CONDITION ERRORS (errx, errv, err d.arrw) 
= (Xs, Vxs, e bs, cjhiHh Vxe, e be, cube) 
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ARE ALL errx, errv, errd b, AND err cub / 
WITHIN PERMISSIBLE RANGES? N 



- ( LEAVE REPETITION LOOP. ) 



DETERMINE A PLURAUTY OF CANDIDATES (Xs+aXs, Vxs, c^^bs, ZMPrecpeok), 
(Xs, Vxs+ aVxs, cobs, ZMPrecpeok), (Xs, Vxs, <obs+ A cobs, ZMPrecpeok), 
(Xs, Vxs, a, bs, ZMPrecpeakt a ZMPrecpeok) IN THE VICINITY OF (Xs, Vxs, cd bs, ZMPrecpeok), 
AND BASED ON THEM, DETERMINE BOUNDARY CONDITION ERROR CORRESPONDING 
TO EACH OF THEM AS DESCRIBED ABOVE. 



DETERMINE NEW CANDIDATES (Xs, Vxs, wbs, ZMPrecpeok) ON THE BASIS OF BOUNDARY 
CONDITION ERRORS CORRESPONDING TO (Xs, Vxs, ojbs, ZMPrecpeok) AND EACH OF 
CANDIDATES IN THE VICINITY THEREOF. 



DETERMINE INITIAL BODY HORIZONTAL POSITION, VELOCITY, POSTURE ANGLE, AND ANGULAR VELOCITY 
(XO, VxO, 9 bO, who), INITIAL BODY VERTICAL POSITION AND VELOCITY (ZO, VzO), AND INITIAL BODY 
POSTURE ANGLE AND ANGULAR VELOaTY AT ORIGINAL INITIAL TIME 0. 



DETERMINE NORMAL TURNING INITIAL DIVERGENCE COMPONENT q[0] 
ACCORDING TO THE FOLLOWING EXPRESSION. 

q[0]^XQ + VxO/a;0 



DETERMINE q", WHICH IS THE VALUE OF NORMAL TURNING INITIAL DIVERGENCE COMPONENT q[0] 
OBSERVED FROM SUPPORTING LEG COORDINATE SYSTEM OF CURRENT TIME GAIT, AND (ZO", VzD"), 
WHICH ARE VALUES OF INITIAL BODY VERTICAL POSITION AND VELOCITY OBSERVED FROM SUPPORTING 
LEG COORDINATE SYSTEM OF CURRENT TIME GAIT. 



RETURN ^ 
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FIG.17 
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ENTRY 
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PROVISIONALLY DETERMINE ZMP CORRECTION PARAMETER CANDIDATE a AND BODY INCUNATION 
RESTORING MOMENT ZMP-CONVERTED VALUE PEAK VALUE CANDIDATES (ZMPrecpeaka, ZMPrecpeakb). 



CALCULATE PROVISIONAL CURRENT TIME GAIT UNTIL TERMINATING TIME ON THE BASIS OF PARAMETER 
OBTAINED BY CORRECTING ZMP PARAMETER, WHICH HAS BEEN PROVISIONALLY DETERMINED BY 
PROVISIONAL DETERMINATION PROCESSING OF CURRENT TIME GAIT PARAMETER, BY ZMP CORRECTION 
PARAMETER CANDIDATE a, BODY INCUNATION RESTORING MOMENT ZMP-CONVERTED VALUE 
PEAK VALUE CANDIDATES (ZMPrecpeaka, ZMPrecpeakb), AND OTHER CURRENT TIME GAIT PARAMETERS. 



DETERMINE TERMINAL DIVERGENCE COMPONENT qO[k] ACCORDING TO THE FOLLOWING 
EXPRESSION FROM BODY POSmONAELOOTY (Xe, Ve) 
AT TERMINATING END OF CURRENT TIME GAIT: 
qO[k] = Xe + Vxe/ajO 



DETERMINE TERMINAL DIVERGENCE COMPONENT ERROR errq 
ACCORDING TO THE FOLLOWING EXPRESSION: 
errq = qO[k]-q'' 



TERMINAL BODY POSTURE ANGLE ERROR 6 berr 
= NORMAL GAIT INITIAL BODY POSTURE ANGLE 

- CURRENT TIME GAIT TERMINAL BODY POSTURE ANGLE 
TERMINAL BODY POSTURE ANGULAR VELOOTY ERROR when 
= NORMAL GAIT INITIAL BODY POSTURE ANGULAR VELOCITY 

- CURRENT TIME GAIT TERMINAL BODY POSTURE ANGULAR VELOOTY 



DETERMINE A PLURALITY OF CANDIDATES (a+ Aa, ZMPrecpeaka, ZMPrecpeakb), 

(a, ZMPrecpeaka+ A ZMPrecpeaka, ZMPrecpeakb), AND 

(a, ZMPrecpeaka, ZMPrecpeakb+ A ZMPrecpeakb) IN THE VICINITY OF 

(a, ZMPrecpeaka, ZMPrecpeakb), AND BASED ON THEM, DETERMINE ERROR CORRESPONDING TO 

EACH OF THEM AS DESCRIBED ABOVE. 



DETERMINE NEW PARAMETER CANDIDATES (a, ZMPrecpeaka, ZMPrecpeakb) ON THE BASIS OF 
(a, ZMPrecpeaka, ZMPrecpeakb) AND ERROR CORRESPONDING TO EACH OF CANDIDATES IN THE 
VICINITY THEREOF. 
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RETURN J 
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FIG.19 

BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE OF NORMAL GAIT (ZMPrec) 
ONE-LEG SUPPORTING PERIOD ONE-LEG SUPPORTING PERIOD 



FLOATING 
PERIOD 



Ts2 



ZMPrecpeak ZMPretpeak 



FIG.20 

BODY INCLINATION RESTORING MOMENT 
ZMP-CONVERTED VALUE OF CURRENT TIME GAIT (ZMPrec) 




ONE-LEG SUPPORTING PERIOD 



